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I. Introduction 

Manufacturing, service, research, exploration and many other areas of human activity require a lot of handling operations of 
a wide variety of objects, materials, parts, etc. The handling operations can be very simple and fuzzy or very complicated and 
precise. Robotic arms are the right tool to automate these operations and to facilitate the processes in almost of any area. At 
this stage, robotic arms, most of them known as manipulation robots, work successfully in many manufacturing areas. 
Usually, those areas are static and unchanging work environments, which allow the robotic arms to perform their operations 
according to advanced done programming. 

The next stage challenge for the robotic arms is their capability to work in considerably cluttered and changing environments 
that can influence their proper functioning. Besides precise execution of the desired operations, the next stage robotic arms 
must ensure safety functioning within their working space. In cases of dynamic and cluttered environments, the robotics arms 
have to adapt to unknown in advance situations. The most important case to consider is ensuring a safety work — namely, 
avoidance of collisions and accidents with the surrounding objects. 

The author’s purpose of this paper is to begin a research on problems of safety functioning of autonomous robotic 
mechanisms in various working environments. 

II. Functional Description of Collision Prevention System 

The collision detection and prevention system consists of three modules that perform the following functions: 

MODULE 1: “Motion Control ” 

This module implements the motion control according to set performance parameters. The motion control includes moving 
the arm end-effectors (EE) to desired positions of the working space and/or realization of desired trajectories of the arm. 

MODULE 2 '“Detection of Obstacle and Distance Measurement ” 

This module checks for presence of obstacles within the working area of the robotic arm and obtains the necessary 
measurements such as the global distance between the arm EE and an obstacle, as well as additional specific distance 
measurements, thus ensuring the complete measuremnet information for the safety work of the arm. 

MODULE 3:“ Judgment for Situation and Decision for Action 

This module evaluates the working scene of the arm, estimates the degree of danger of the current situation and decides how 
to safely continue the current process. The possible decisions and actions are: 

i. No danger situation and the motion can continue to the desired position or along the desired trajectory; 

ii. Collision is possible - correction of the desired position or the desired trajectory; 

iii. STOP - inevitable collision detected, impossibility to correct the motion, operator assistance required. 

The block structure of the collision detection and prevention system is presented in Fig.l. 
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FIG 1. BLOCK STRUCTURE OF THE COLLISION PREVENTION SYSTEM 

The system variables of the modules are described as follows: 


MODULE (l) 


FF 

G - set point for the arm end - effector (EE), 

®L1’®L2 " set P°i nts for controller 1 and controller 2, 
(q^(t),qj(t))-linkl moves towards setpoint position g L1 , 
(q 2 (t),q 2 (t))-link 2 moves towards setpoint position g L2 , 


pi pi pi 

'V-V e 


-EE succesive possitions P 


MODULE (1) 


Fj 2 - check for presence of OBSTACLES, 

9 

- glob_dist OBST measurement of global distance to OBSTACLE, 
y 2 - dist L i ohst measurement of distance of link 1 to obstacle, 
y 3 - dist L2 obst measurement of distance of link 2 to obstacle, 
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3 

Fj = CC closnss - criterionof closeness, 

Y, 3 - evaluation - - 1 glob_dis^ BST - CC elosnss | 

- - - Decisionfor a degree of danger, 

MODULE (3) o 

y j j — no collisiondanger — > continuation of motion, 

3 

Yl 2 — collisions possibles trajectory corection, 

3 

y^ — STOP — > impossiblemotion,necessityof operator's help; 


III. Mathematical Basis 

The dynamic model of n-dof robotic arm is well known as [1]: 

D(e)0+c(e,e)e = T (i) 

Where 0, 0, 0, T e R n are n- vectors of joints position, velocity, acceleration and input driving torque, D(0) e R nxn 
matrix of inertia forces, C(0,0) e R n matrix of centrifugal and coriolis forces? 

The state vector x(t) G R 2n consists of robotic arm joint angles and velocities [0,0] : 

x(0 = [#i(0 e 2 (t)...d n (t) \ d f (t) d 2 {t)...e n {t)] 

The equation (1) is transformed in state space form: 

x(t) = Ax (t) + Bu(t) (2) 


where A = 


-D -1 (0) C(0,0) 


and the control input is u (t) = j{t ) . 


A state space equation for a separate link i can be written as: 

x l (t) = A l x l (t) + B l u l (t)+ X Vyljit ) ^ 

j=hj*i 

with (0) = x io , i = l,2,...,n as initial conditions for the links, and l j{t) - the closest distance between link j and detected 

OB ST 

obstacle, denoted as OB ST, V- matrix of connections. 


A. Free of Obstacle Control 

Equation (2) is presented in discrete form as [2] : 

x *+l =A*X t + B *U* (4) 

The matrixes A and B are calculated according to known formulas: 

T 

A* = 0>(T 0 ) = L~ 1 {[pi - A]}: 1 , B* = H(T 0 ) = \ ’o(r) B dr (5) 

l ~ A o o 


and T 0 is discretization interval for the system variables. 
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Closing the open system (4) by a feedback gain matrix K = [kl k2] and after some routine transformations, the state of the 
closed system becomes: 

x, +1 =[A*-B*K]x,+B*u° (6) 

The control input is calculated as [2] : 

u?=Gf-Kx, (7) 

where is the control input that ensures free movement of the arm end-effectors (EE) to the desired position when no 
obstacles exist within the working space of the robotic arm. 


B. Obstacle consideration and motion correction 

The closed system is described, after taking into account obstacle existence, as: 


X* +1 = [A* - B*K]x, + B*Gf + F *Z° k bst 


( 8 ) 


obst 


The control input contains a second component : 


(9) 


where F(T 0 ) = j* ®(r) C dr = F* and M° bst is the component of the control vector that realizes trajectory correction after 


considering existence of obstacle around the EE or the link j 
Combining (7), (8) and (9) one can get the model: 


x * + i = A x* +B Kiij. +B u k +F z k 


( 10 ) 


The following relation is considered for the purpose of control correction as a result of existence of potential collision for 
link j and an obstacle, detected in the near closeness: 


B*ui+r z . k =i. k 


(in 


( 12 ) 


The results from a computer program simulation are shown in Fig. 2(a,b,c,d) [3]. 

Fig.2a shows a potential collision situation. The second link is very close to the obstacle. 
Fig.2b shows collision occurrence, when the second link crashes the obstacle. 

Fig. 2c shows obstacle avoidance from the robotic arm end-effectors. 

Fig.2d shows collision-free motion after the collision avoidance. 


where l ■ k is the closest measured distance between the link j and the obstacle. Based on the above equation it is 
calculated: 

«M=(- BVF'z^B*)- 1 /,.* 

z 

where Uj k is the control input to correct the motion because of obstacle presence near link j . 

IV. Basic Simulations for 2 dof Planar Robotic Arm 
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Potential Collision Collision Occurrence 


Collision Avoidance 



Fig. 2a 


Fig.2b 



Fig.2c 


Collision-Free Motion 



Fig. 2d 


V. Conclusion 


A generic functional model for collision avoidance and collision free-motion of robotic arms is proposed. Basic simulation 
result for two dof planar robotic arm is presented. Further detailization of research is under planning. 
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